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© LASER ROBOT AND ITS CONTROL METHOD, OPTICAL BEAM DEFLECTION APPARATUS AND 
APPARATUS FOR GENERATING ITS CONTROL SIGNAL. 



© This invention belongs to a technical field relating to a laser robot and its control method, and more 
particularly makes it possible to weave a laser beam easily and accurately without disposing an oscillating 
condenser lens or the like on an arm tip portion. In the laser robot RB of this invention, a first inclined mirror 
(41a) is fitted to a motor (42a) at a predetermined angle of inclination from a plane perpendicular to the rotor 
shaft. A second inclined mirror (41 b) is likewise fitted to the motor (42b) at a predetermined angle of inclination. 
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A laser beam (LB) emitted from a laser oscillator (8) is sequentially reflected at the first and second inclined 
mirrors (41a) and (41b) in the laser robot (RB) and directed toward a work through the tip of a torch (7). A 
weaving mode of the laser beam (LB) is selected by controlling the rotating directions, the number of revolutions 
and the rotating phases of the first and second inclined mirrors (41a) and (41b). 
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40a.40b:INCUNED MIRROR ROTATION MECHANISMS 
4a,41b:INCLINED MIRROR 
LB:LASER BEAM 
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FIELD OF THE INVENTION 

The present invention relates to a laser robot and a method of controlling the same, and a light beam 
deflector applicable to the laser robot and the like, and a device for controlling the light beam deflector. 
5 More particularly, it relates to a technique for periodically changing the direction in which a laser beam is 
emitted from a torch. 

BACKGROUND ART 

10 Laser robots have found various applications, and their use as welding robots has attracted much 

attention recently. In butt welding and the like, however, there are found a large number of non-uniform 
gaps between workpieces, and a laser beam has a considerably small spot diameter. There arises a 
problem that sufficient welding results cannot be achieved without performing weaving weld in which the 
illuminating direction of the laser beam is changed. For the use of the laser robots as the welding robots, it 

75 is necessary to improve the weaving performances thereof. 

It has been known that a system for imparting weaving function to the laser robots can be roughly 
divided into two types. 

One of the types is a system conventionally used for arc welding robots and the like, in which a laser 
torch LT is moved in the direction of a beveled edge while the laser torch LT itself is periodically fluctuated 
20 in the direction perpendicular to the direction of the beveled edge, as shown in Fig. 43(a) (arrow A1). 

The other is a system in which the laser torch LT is moved in the direction of the arrow A2 of Fig. 43(b) 
along the beveled edge while the deflection angle of the laser beam emitted from the laser torch LT is 
periodically changed as indicated by the arrow A3. For achievement of the system of the second type, 
there are two known methods: 
25 (1) a method of periodically vibrating or fluctuating a condenser lens for the laser beam, and 
(2) a method of deflecting the laser beam by the combination of a pair of galvano mirrors. 
The first system, however, has a problem that welding speed is low because an arm for fluctuating the 
torch cannot be moved at very high speed. 

In the method (1) of the second system, it is necessary to equip the leading edge portion of the arm 
30 with a lens drive mechanism since the condenser lens is mounted adjacent to the leading edge of the arm. 
This structure increases the size and inertia of the leading edge portion of the arm, resulting in increased 
interference between the leading edge portion of the arm and obstructions and deterioration in control- 
lability. 

In the method (2) of the second system, there arises a problem that drive control for the galvano mirrors 
35 is not easy. That is, since a laser used for welding is a high power laser (e.g., a carbon dioxide laser of CW 
oscillation type), the material and thickness of the galvano mirrors are required to resist the high power, and 
the inertia of the galvano mirrors necessarily increases. Since the galvano mirrors must be vibrated at high 
frequencies, a torque load on a vibrating mechanism for the galvano mirrors changes violently. A a result, 
the vibrations of the respective galvano mirrors are difficult to be in synchronism with each other. 
40 These problems are not limited to the welding robots but are common to the laser robots in which the 
laser beam is required to be deflected periodically. 

DISCLOSURE OF THE INVENTION 

45 The present invention is directed toward overcoming the problems. It is a primary object of the present 
invention to provide a laser robot for periodically deflecting a laser beam, which is capable of preventing 
interference between a leading edge portion of an arm and obstructions, which is capable of controlling the 
periodical deflection of the laser beam without difficulty and is excellent in control accuracy, and which is 
capable of sufficiently increasing a deflection speed and, therefore, a welding speed. 

so It is another object of the present invention to provide a method of controlling the laser robot exactly. 

It is still another object of the present invention to generalize a new structure for use in the laser robot 
as a light beam deflector. 

It is a further object of the present invention to provide a control signal generator for the light beam 
deflector. 

55 The present invention provides the new structure in the aforesaid second system, a method of 
controlling the same, and a control signal generator therefor. 
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A laser robot in a first constitution of the present invention is adapted such that a plurality of inclined 
mirror rotation mechanisms for rotating a plurality of inclined mirrors inclined from planes perpendicular to 
directions of predetermined rotation axes on the rotation axes respectively are arranged in series along an 
optical path of the laser beam, such that the laser beam is reflected serially by the plurality of inclined 
5 mirrors while the plurality of inclined mirrors rotate on the rotation axes by means of the plurality of inclined 
mirror rotation mechanisms respectively, and such that the reflected laser beam is emitted from a torch, 
whereby the direction in which the laser beam is emitted from the torch is periodically deflected. 

According to the laser robot of the present invention, each of the inclined mirrors has a function of 
periodically deflecting the laser beam by its rotation. By the combination of the plurality of inclined mirrors 
w and appropriate setting of relative rotation directions thereof and rotation phase difference therebetween, the 
deflection mode, deflection cycle, amplitude of the laser beam and so on can be changed. 

Therefor, the designation of the travelling speed of the torch, the travelling distance of the torch during 
one cycle of deflection, the amplitude of the deflection mode and so on permits calculations of the desired 
numbers of rotations of respective inclined mirrors and the desired rotation phase difference between 
75 adjacent inclined mirrors. 

Since there is no need to mount the inclined mirrors and the rotation mechanisms on the leading edge 
of the arm, interference between the leading edge of the arm and obstructions due to increased size of the 
leading edge of the arm can be effectively prevented. 

Since the mirrors do not vibrate such as galvano mirrors but only rotate, there is generated no violent 
20 change in acceleration in the rotation directions of the mirrors. This provides for improvement in periodical 
deflection speed, easy synchronization control between the mirrors, and high controllability of the laser 
beam. 

The laser robot in a second constitution of the present invention is adapted such that the plurality of 
inclined mirrors are equal in the number of rotations and in rotation direction in the laser robot of the first 
25 constitution. 

The laser robot in a third constitution of the present invention is adapted such that the plurality of 
inclined mirrors are equal in the number of rotations and adjacent ones of the plurality of inclined mirrors 
are mutually opposite in rotation direction. 

According to the present invention, a method of controlling a laser robot which propagates a laser beam 

30 along an arm and performs a predetermined processing while directing the laser beam from a torch 
mounted on a leading edge of the arm to workpieces and travelling the torch along a processing line on the 
workpieces, comprises a first step of arranging a plurality of inclined mirrors and a plurality of inclined 
mirror rotation mechanisms in series along an optical path of the laser beam, the plurality of inclined mirrors 
having reflecting surfaces inclined from planes perpendicular to directions of predetermined rotation axes 

35 respectively and serially reflecting the laser beam by their reflecting surfaces to introduce the laser beam to 
the torch, the plurality of inclined mirror rotation mechanisms rotating the plurality of inclined mirrors on the 
rotation axes, respectively, a second step of specifying speeds at which the torch travels along the - { 
processing line while performing the predetermined processing and a distance the torch travels along the 
processing line within a cycle of deflection of the laser beam, a third step of specifying a spin diameter of 

40 the laser beam emitted from the torch, a fourth step of determining the numbers of rotations of the plurality 
of inclined mirrors as a function of the speeds and the distance, a fifth step of determining a rotation phase 
difference between two of the inclined mirrors which are adjacent to each other as a function of the spin 
diameter, and a sixth step of producing drive outputs as a function of the numbers of rotations and rotation 
phase difference which are determined in the fourth and fifth steps and applying the drive outputs to the 

45 plurality of inclined mirror rotation mechanisms to rotate the plurality of inclined mirrors in the same 
direction with the same number of rotations held. 

In the method, the numbers of rotations of the plurality of inclined mirrors rotating in the same direction 
with the same number of rotations held are determined by the travelling speed of the torch and the spin 
pitch, and the rotation phase difference therebetween is determined uniquely by the spin diameter. As a 

so result, the plurality of inclined mirrors can be effectively controlled such that weaving of the laser beam can 
be exactly performed in the spin mode without difficulty. 

In another constitution of the present invention, a method of controlling a laser robot which propagates a 
laser beam along an arm and performs a predetermined processing while directing the laser beam from a 
torch mounted on a leading edge of the arm to workpieces and travelling the torch along a processing line . 

55 on the workpieces, comprises a first step of arranging a plurality of inclined mirrors and a plurality of 
inclined mirror rotation mechanisms in series along an optical path of the laser beam, the plurality of 
inclined mirrors having reflecting surfaces inclined from planes perpendicular to directions of predetermined 
rotation axes respectively and serially reflecting the laser beam by their reflecting surfaces to introduce the 
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laser beam to the torch, the plurality of inclined mirror rotation mechanisms rotating the plurality of inclined 
mirrors on the rotation axes, respectively, a second step of specifying speeds at which the torch travels 
along the processing line while performing the predetermined processing and a distance the torch travels 
along the processing line within a cycle of deflection of the laser beam, a third step of specifying Cartesian 
5 position coordinates of a tip of the torch at processing points on which the predetermined processing is to 
be performed in the processing line and drive amounts of the arm for travelling the torch onto the 
processing points, a fourth step of determining the numbers of rotations of the plurality of inclined mirrors 
* as a function of the speeds and the distance, a fifth step of determining a rotation phase difference between 

two of the inclined mirrors which are adjacent to each other for each of the processing points as a function 
io of the position coordinates and the drive amounts, and a sixth step of producing drive outputs as a function 
of the numbers of rotations and rotation phase difference which are determined in the fourth and fifth steps 
and applying the drive outputs to the plurality of inclined mirror rotation mechanisms to rotate adjacent ones 
of the plurality of inclined mirrors in opposite directions with the same number of rotations held. 

In the method, the numbers of rotations of the plurality of inclined mirrors which are equal in the 
75 number of rotations and adjacent ones of which rotate in the opposite directions are determined by the 
travelling speed of the torch and the spin pitch, and the rotation phase difference therebetween is 
determined b y information of the position of the torch and the drive amounts of the arm for each processing 
! P° int - Th 'S provides compensation for the influence of the drive of the arm on the deflection of the laser 

beam. The plurality of inclined mirrors can be effectively controlled such that weaving of the laser beam is 
20 performed in the scan mode with the oscillation direction of the laser beam constantly maintained 
perpendicularly to the direction tangential to the processing line and the center axis of the torch. 

According to the present invention, a light beam deflector for periodically deflecting a light beam 
comprises first and second inclined mirrors having reflecting surfaces inclined from planes perpendicular to 
directions of predetermined rotation axes respectively and arranged in series along an optical path of the 
25 light beam for serially reflecting the light beam by their reflecting surfaces to introduce the light beam to a 
predetermined space, first and second inclined mirror rotation mechanisms for rotating the first and second 
inclined mirrors on the rotation axes, respectively, and control means for controlling rotations of the first and 
second inclined mirror rotation mechanisms, wherein the light beam is reflected in series by the first and 
second inclined mirrors while the first and second inclined mirrors rotate in response to a control signal 
30 applied to the inclined mirror rotation mechanisms by the control means, to thereby periodically deflect the 
light beam in the predetermined space. 

Therefore, according to the light beam deflector of the present invention, there is provided a module 
capable of periodically deflecting the light beam. 

The light beam deflector is applicable to the laser robot of the present invention, and has an effect of 
35 improving the deflection accuracy and deflection speed of the light beam. 

Different deflection modes are obtained between the case where the rotation directions of the first and 
{ second inclined mirrors are the same and the case where they are opposite. When the rotation directions of 

the first and second inclined mirrors are the same, the spin mode can be selected for the deflection locus of 
the light beam. When the rotation directions of the first and second inclined mirrors are opposite, the scan 
40 mode can be selected for the deflection locus of the light beam. 

According to the present invention, a control signal generator for use in the light beam deflector as 
control means for generating control signals to be applied to the first and second rotation mechanisms, 
comprises a controller for calculating the numbers of rotations of the first and second rotation mechanisms 
and a rotation phase difference between the first and second rotation mechanisms as a function of a 
45 predetermined algorithm, a processor connected to an output portion of the controller for calculating the 
umbers of pulses to be applied to the first and second rotation mechanisms respectively per predeter- 
mined time from a calculation result of the controller in response to a first timing pulse signal to output 
calculation results with respect to the numbers of pulses as first and second calculation results respectively, 
a first pulse train formation circuit connected to one output portion of the processor for converting the first 
so calculation result into a pulse train to form a first pulse train signal in response to a second timing pulse 
signal, to apply the first pulse train signal to the first rotation mechanism, a second pulse train formation 
circuit connected to the other output portion of the processor for converting the second calculation result 
into a pulse train to form a second pulse train signal in response to the second timing pulse signal, to apply 
the second pulse train signal to the second rotation mechanism, and a timing pulse generation circuit for 
55 generating the first and second timing pulse signals. 

The processor in the control signal generator for the light beam deflector according to the present 
invention, receiving the first timing pulse for each predetermined time, receives from the controller the 
calculation results with respect to the numbers of rotations and rotation phase difference calculated by the 
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controller and to be applied to the first and second rotation mechanisms, calculates the numbers of pulses 

to be applied to the first and second rotation mechanisms per predetermined time in accordance with the 

calculation results, and outputs the calculation results with respect to the numbers of pulses as the first and 

second calculation results. The processor controls the respective numbers of pulses to be applied to the 
5 first and second rotation mechanisms for each predetermined time. 

Subsequently, the first pulse train formation circuit converts the first calculation result into a pulse train 

in response to the second timing pulse signal. 

Similarly, the second pulse train formation circuit converts the second calculation result into a pulse 

train in response to the second timing pulse signal. 
w This provides the first pulse train signal having pulses the number of which corresponds to the first 

calculation result per predetermined time and the second pulse train signal having pulses the number of 

which corresponds to the second calculation result per predetermined time. 

In the control signal generator for the light beam deflector, continuous high-speed rotations of the 

inclined mirors are effectively performed with the predetermined numbers of rotations and predetermined 
is rotation phase difference held for each predetermined time, while the two rotation mechanisms in the light 

beam deflector are accelerated and decelerated for each predetermined time for the purpose of periodically 

deflecting the light beam in the predetermined mode. 

The control signal generator for the light beam deflector, composed of simple electrical structure, 

controls the rotations of the two rotation mechanisms by replacing with the two pulse train signals the 
20 informations for rotating the two rotation mechanisms with the predetermined numbers of rotations and 

predetermined rotation phase difference held for each predetermined time, so that the two rotation 

mechanisms can be exactly controlled with ease without an error of a single pulse. 

BRIEF DESCRIPTION OF THE DRAWINGS 

25 

Fig. 1 schematically shows an optical structure of a laser welding robot according to a preferred 
embodiment of the present invention; 

Fig. 2 is an external perspective view showing a mechanical structure of the laser welding robot 
according to the preferred embodiment of the present invention; 
30 Fig. 3 illustrates weaving weld by the laser welding robot according to the preferred embodiment of the 
present invention; 

Fig. 4 is a cross-sectional view showing the structure of a first inclined mirror rotation mechanism in 
detail; 

Fig. 5 is a cross-sectional view showing the structure of a second inclined mirror rotation mechanism in 
35 detail; 

Fig. 6 is a block diagram of a control system of the first and second inclined mirror rotation mechanisms; 
Fig. 7 illustrates periodical deflection of a laser beam by first and second inclined mirrors for geometrical 
analysis; 

Fig. 8 illustrates the definitions of a clockwise direction CW and a counterclockwise direction CCW; 
40 Figs. 9 and 10 illustrate direction vectors of the laser beam for analysis, respectively; 

Fig. 11 is a two-dimensional schematic view for determining a reflection direction of the laser beam 
where the first and second inclined mirrors are equal in rotation direction, in the number of rotations and 
in rotation phase; 

Fig. 12 is a two-dimensional schematic view for determining the reflection direction of the laser beam 
45 where the first and second inclined mirrors are equal in rotation direction and in the number of rotations 
and are different in rotation phase; 

Fig. 13 is a two-dimensional schematic view for determining the reflection direction of the laser beam 
where the first and second inclined mirrors are opposite in rotation direction, and are equal in the 
number of rotations and in rotation phase; 
so Fig. 14 is a two-dimensional schematic view for determining the reflection direction of the laser beam 
where the first and second inclined mirrors are opposite in rotation direction, are equal in the number of 
rotations, and are different in rotation phase; 

Fig. 15 illustrates an example of simulation results of rotations in the same direction; 
Fig. 16 illustrates an example of simulation results of rotations in opposite directions; 
55 Fig. 17 illustrates properties of a spin mode according to the preferred embodiment; 
Fig. 18 illustrates properties of a scan mode according to the preferred embodiment; 
Fig. 19 schematically shows an optical structure of the laser welding robot according to another preferred 
embodiment of the present invention; 
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Fig. 20 schematically illustrates an optical system of a laser robot which has an optical arrangement 
similar to the laser robot shown in Fig. 19, and degrees of freedom of respective drive portions of the 
robot; 

Fig. 21 schematically illustrates scanning of the, laser beam along a weld line drawing a spiral locus on 
5 workpieces; 

Fig. 22 illustrates loci of the laser beam where the first and second inclined mirrors are in an ideal state; 
Fig. 23 is a block diagram of a control system of the laser robot; 

Figs. 24 to 26 are a flow chart of a control procedure of the laser robot in the spin mode; 
Fig. 27 illustrates interpolation by a curve SC; * 
io Fig. 28 schematically illustrates relation between a beam spot of the laser beam on the workpiece and 
the weld line; 

Fig. 29 schematically illustrates positional relation between a torch vector and a processing point; 
Fig. 30 schematically illustrates change in oscillation direction where the laser beam which oscillates on 
a line having an inclination 6 is reflected by a fixed mirror; 
75 Fig. 31 schematically illustrates change in oscillation direction where the laser beam which oscillates on 
an Xi axis is reflected by a mirror which revolves or pivots; 

Fig. 32 illustrates coordinate systems determined for expression of the oscillation direction of the laser 
beam which is propagated while oscillating in the scan mode in the optical system of the laser robot; 
Fig. 33 schematically illustrates positional relation between a unit vector "e 0 and a vector w; 
20 Fig. 34 illustrates coordinate systems determined for expression of the oscillation direction of the laser 
beam which is propagated in a beam weaver; 

Fig. 35 illustrates a flow for determining a rotation phase difference for the scan mode; 
Figs. 36 to 38 are a flow chart of a control procedure of the laser robot in the scan mode; 
Fig. 39 is a block diagram showing an electrical structure of a control signal generator for a light beam 
25 deflector according to a preferred embodiment of the present invention; 

Fig. 40 is a block diagram showing an electrical structure of first and second pulse train formation 
circuits; 

Fig. 41 is a timing chart of operations of respective components until a first pulse train signal is 
produced; 

30 Fig. 42 is a timing chart of operations of the respective components until a second pulse train signal is 
produced; and 

Fig. 43 illustrates conventional methods in an arc welding robot and the like. 



35 



BEST MODES FOR CARRYING OUT THE INVENTION 
Laser Robot and Light Beam Deflector 
(A) Mechanical Structure 

40 Fig. 2 is an external perspective view showing a mechanical structure of a laser welding robot RB 
according to a first preferred embodiment of the present invention. In the robot RB, a hollow revolving 
column 2 revolvable on a revolution axis Z is supported on a base 1 . The revolving column 2 supports a 
hollow lift body 3 vertically movable on the revolution axis Z. The lift body 3 supports a hollow horizontal 
arm 4 expandable on a horizontal axis Y which is perpendicular to the revoltion axis Z. 

45 A first hollow pivotal body 5 pivotable on the horizontal axis Y is supported at the leading edge of the 
hori2r. ntal arm 4. The first pivotal body 5 supports a second hollow pivotal body 6 pivotable on an axis V 
which is perpendicular to the pivot axis of the first pivotal body 5 (corresponding to the horizontal axis Y). A 
laser torch (nozzle) 7 is mounted on the second pivotal body 6 in the direction of an axis W which is 
perpendicular to the pivot axis V. 

so A laser beam oscillated by a carbon dioxide laser oscillator 8 is reflected downwardly by a reflector 9. 
The optical axis of the reflected light coincides with the revolution axis Z. The laser beam passes through 
the respective members 3 to 6 while reflected in series by mirror systems described below to be emitted 
from the tip of the laser torch 7. The laser beam is periodically deflected relative to the center axis W of the 
laser torch 7 by the function of a pair of inclined mirror rotation mechanisms described later. 

55 By travelling the laser torch 7 in the B direction of Fig. 3 along a butted portion 23 of workpieces 21 
and 22 in butt welding as shown in Fig. 3, the butted portion 23 can be welded by weaving. In this welding, 
no welding rod is used, but the workpieces 21 and 22 are joined by the melting thereof. 
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(B) Optical Structure 

Fig. 1 schematically shows an optical structure of the laser welding robot RB shown in Fig. 2. The laser 
beam LB oscillated by the laser oscillator 8 is reflected by a mirror 31 in the reflector 9. and is directed 
5 through the revolving column 2 into the lift body 3. 

An optical system in the lift body 3 includes fixed mirrors 32 to 34, a first inclined mirror 41a mounted 
to a first inclined mirror rotation mechanism 40a and a second inclined mirror 41b mounted to a second 
inclined mirror rotation mechanism 40b. The laser beam LB which enters the lift body 3 is reflected in 
series by the mirrors 32, 33. 34 to be incident on the first inclined mirror 41a. 

io Fig. 4 is a cross section showing the structure of the first inclined mirror rotation mechanism 40a in 
detail. The first inclined mirror 41a is mounted to a rotor shaft 43a of a motor 42a such that its mirror 
surface is inclined at an angle A0i from a plane PLi perpendicular to a rotation axis direction RAi of the 
rotor shaft 43a. The rotation axis direction RAi is inclined at an angle 0i from an incident axis of the laser 
beam LB. This permits periodical change in the direction in which the laser beam LB is reflected from the 

15 first inclined mirror 41a when the first inclined mirror 41a is rotated by the motor 42a. Assuming a virtual 
state in which the first inclined mirror 41a is disposed in the plane PLi and referring to a travelling path RP1 
of the laser beam LB reflected in this state as a "reference optical path", the actual optical path of the 
reflected laser beam LB periodically changes on a conical surface whose center axis is the reference optical 
path RP1 . The details of the periodical change will be described later. The laser beam LB reflected by the 

20 first inclined mirror 41a is further reflected by the second inclined mirror 41b (see Fig. 4) provided on the 
extension line of the reference optical path RP1 . 

A rotary encoder 44a for detecting the rotation angle of the rotor shaft 43a is housed in the motor 42a, 
which is preferably a direct drive servomotor. 

The first inclined mirror 41a is arranged such that its center (the point of attachment to the rotor shaft 

25 43a) is on the reference optical path RP1. 

Fig. 5 is a cross section showing the structure of the second inclined mirror rotation mechanism 40b in 
detail. The second inclined mirror 41b is mounted to a rotor shaft 43b of a motor 42b such that its mirror 
surface is inclined at an angle A0 2 from a plane PU perpendicular to a rotation axis direction RA2 of the 
rotor shaft 43b. The rotation axis direction RA2 is inclined at an angle B 2 to the reference optical path RP1 

30 shown in Fig. 4. The angle 0i shown in Fig. 4 may be, in general, different from the angle e 2 , however, it is 
supposed that Qy = e 2 for convenience in the preferred embodiment. That is, it is supposed that the 
rotation axis direction RAi in the first inclined mirror rotation mechanism 40a is parallel to the rotation axis 
direction RA 2 in the second inclined mirror rotation mechanism 40b. The inclination angles Afli and A6 2 
may be equal to or different from each other, however, it is supposed that A0i = A6 2 in the preferred 

35 embodiment 

In the second inclined mirror rotation mechanism 40b, when the second inclined mirror 41b is rotated 
by the motor 42b, the direction in which the laser beam LB is reflected from its mirror surface periodically 
changes. The rule of the change described later in detail is determined by the numbers of rotations of the 
first and second inclined mirrors 41a and 41b, the rotation phase difference therebetween, and the angles 

40 A61 and A0 2 . Assuming a virtual state in which the mirror surface of the second inclined mirror 41b is in the 
plane PL 2 and the laser beam LB is incident along the reference optical path RP1, the optical path of the 
reflected laser beam LB is a reference optical path RP2. 

A rotary encoder 44b for detecting the rotation angle of the rotor shaft 43b is housed in the mootor 42b, 
which is preferably the direct drive servomotor. 

45 The second inclined mirror 41b is arranged such that its center (the point of attachment to the rotor 
shaft 43b) is on the reference optical path RP2. 

The combination of the pair of inclined mirror rotation mechanisms 40a and 40b shown in Figs. 4 and 5 
may be formed into a single module as a light beam deflector. 

With reference again to Fig. 1, the laser beam LB which is reflected in series by the first and second 

50 inclined mirrors 41a and 41 b and is emitted from the optical system 30 of the lift body 3 passes through the 
horizontal arm 4 and is reflected by a fixed mirror 35 in the first pivotal body 5. The reflected laser beam LB 
is converted into a focused beam by a parabolic mirror 36 mounted in the second pivotal body 6 to be 
directed from the torch 7 toward the workpiece. In practice, the travelling direction of the laser beam LB 
after reflection from the first inclined mirror 41a periodically changes by the rotations of the first and second 

55 inclined mirrors 41a and 41b. The travelling direction is shown in Fig. 1 represented by the reference optical 
paths RP1 and RP2. 
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(C) Electrical Structure 

Fig. 6 is a block diagram of control system of the first and second inclined mirror rotation mechanisms 
40a and 40b shown in Figs. 4 and 5. An input/output unit 53 provides the information of the operations of 

5 respective arms of the robot RB shown in Figs. 1 and 2 and the information of welding conditions. The 
informations are inputted to a robot controller 52. The robot controller 52 produces command values to be 
outputted to respective arm drive motors of the robot RB and laser ON/OFF command values to be given to 
the laser oscillator 8. The robot controller 52 gives a motor controller 51 command values of the numbers of 
rotations Ni. N 2 , initial phase command values $i , <t> 2 and rotation direction command values (not shown) 

io for the motors 42a and 42b. 

The motor controller 51 outputs motor drive powers Di and Cfe to the motors 42a and 42b respectively 
as a function of the command values. Rotation angle detection signals Ei and E 2 from the rotary encoders 
44a and 44b are fed back to the motor controller 51 . The mutual relation between the numbers of rotations 
Ni, N 2 , rotation directions and initial phases <t> 2 of the motors 42a. 42b, which is described in the next 

75 section, is a factor for determining the mode and width of the weaving, etc. 

(D) Details of Beam Deflection by Rotation of Mirrors 



Fig. 7 illustrates the periodical deflection of the laser beam LB by the first and second inclined mirrors 
20 41a and 41b for geometrical analysis thereof. For the rotation directions of the first and second inclined 
mirrors 41a and 41b, a "clockwise direction CW" and a "counterclockwise direction CCW" are defined as 
viewed from the initial point ST of a vector RP (of Fig. 8) which connects the first and second inclined 
mirrors 41a and 41b and is parallel to the reference optical path RP1. 
Vectors in Fig. 7 are defined as follows: 
25 (1) Vector S is a unit vector which is parallel to the direction in which the laser beam LB is incident on 
the first inclined mirror 41a and has the direction opposite thereto. 

(2) Vector *fc> indicates the direction in which the laser beam LBJs reflected from the first inclined mirror 
41a. Vector (-b) which has the direction opposite to the vector 15 is parallel to the direction in which the 
laser beam _LB is incident on the second inclined mirror 41b and has the direction opposite thereto. 
30 (3) Vector "c indicates the direction in which the laser beam LB is reflected from the second inclined 
mirror 41b. 

(4) Vector mi is a unit vector normal to the mirror surface of the first inclined mirror 41a. 

(5) Vector m 2 is a unit vector normal to the mirror surface of the second inclined mirror 41b. 

From the rule of light reflection by the first and second inclined mirrors 41a and 41b, the following 
35 formulas (1) and (2) hold: 



where "x" indicates a vector product, and ki, k 2 are normalization coefficients for setting the lengths of the 
vectors a* and U to "1 ". 



40 
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ii? 2 x(-S) = (k 2 c)xm 2 
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(2) 



45 



From the formulas (1) and (2), the following formulas are obtained: 



50 




(4) 



(3) 



where "• " indicates a scalar product. 

Substitution of the formula (3) into the formula (4) gives 



55 
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k 1 k 2 c = -^+(m 1 -^)m 1 +(m 2 -a)^ 2 -(m 1 -a) ("m^m^^ 



The vectors b and ~c are given by the vectors "a, mi and m 2 - 

The vectors mi and m 2 rotate around the direction RAi and RA2 inclined at the angles A0i and A6 2 
from the rotation axis directions RA1 (Fig^4) andRA* (Fig. 5) of the rotor shafts 43a and 43b, respectively. 
10 The influence of changes of the vectors mi and m 2 with time by the rotational drives of the motor 42a and 
42b on the vector "c can be known on the basis of the formula (5). This analysis can be performed by 
simulation. However, for clarifying its basic properties, a qualitative analysis will be performed below. 

With reference to Fig. 9, the terminal point ME, of the vector in, travels on a circle MCi by the 
rotational drive _of the motor 42a. It is assumed that the second term on the right-handed side of the formula 
75 (3) is a vector F1. 



30 



35 



= (m 1 -a)m 1 ... (6) 



20 



The vector F 1 extends in the same direction as the vector mi, and its length (vector If • vector m t ) 
changes according to the relative angte between the vector mi and the vector "a . Since the vector ~S is 
fixed, the terminal point of the vector F 1 periodically rotates on an ellipse EL1 . Since the first term on the 
right-handed side of the formula (3) is a fixed vector as described above, the terminal point of the vector (- 
2s ki b ) which is obtained by introducing a minus sign to a difference between the first and second terms also 
travels on the ellipse EL1 . 

Assuming that the second term on the right-handed side of the formula (7) which is obtained by 
changing the formula (4) is a vector P 2 , the vector P 2 has similar dependence on the vectors m 2 and 1>. 



k l k 2° = -k 1 b+(m 2 .k 1 b)m 2 ... (7) 

F 2 = (^.^b)^ ... (8) 

When the vector 1> is fixed, the terminal point of the vector (kik2*c) travels on another ellipse EL2 (not 
shown in Fig. 9). 

These situations are schematically shown in Fig. 10. The vector "a is converted into the vector (k t K) by 
the reflection from the first inclined mirror 41a, and the vector (ki"E) is converted into the vector (kik 2 cT) by 

40 the reflection from the second inclined mirror 41b. The respective conversions are indicated by points on 
the ellipses EL1 and EU. The analysis described below relates to the vector (kik 2 *c), which is different in 
length from the vector "c . Since what is to be determined is not the length of the vector "c but the direction 
thereof, no problem occurs by the difference. 

After the above-mentioned preparation, reference is made to Figs. 11 to 14, which illustrate relation 

45 between the ellipses ELi and EU of Fig. 10 two-dimensional ly, schematically and conceptually. The closed 
circles of Figs. 11 to 14 indicate the terminal points of the vector (-kil?), and the open circles indicate the 
terminal points of the vector (k,k 2 c*). The ellipses EL2 are drawn in plurality around the ellipse EU because 
the center of the ellipse EL 2 changes according to the position of the terminal point of the vector (-ki ~S). 
Fig. 11 shows the case where the first and second inclined mirrors 41a and 41b rotate in the same 

50 direction (counterclockwise in Fig. 11) and have the same number of rotations Ni and 1^, and the phase 
difference A<*> given by the formula (9) is zero. The phase is defined as zero when the closed circle is at 
the top of the ellipse ELi , and the phase <fc> is defined as zero when the open circle is at the bottom of the 
ellipse EU>. When the first and second inclined mirrors 41a and 41b rotate, changes in reflecting angle due 
to the rotations are cancelled and the terminal point (indicated by the open circle) of the vector (ki ^"c ) 

55 remains at the same point. 

A<f> = *i - <t> 2 (9) 
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Fig. 12 shows the case where the phase difference A$ is a finite value (and other conditions are the 
same as in the case of Fig. 11). The locus of the terminal point of the vector (kik 2 "c) draws an ellipse El_a. 
Various changes in phase difference A* change the size of the ellipse EU as the locus of the open circle. 
Fig. 13 shows the case where the first and second inclined mirrors 41a and 41b rotate in the opposite 
5 directions (clockwise and counterclockwise) and have the same number of rotations Ni and N 2 , and the 
phase difference A* is zero. The terminal point of the vector (kik 2 "c) reciprocates on a line segment LN a . 

Fig. 14 shows the case where the phase difference A<f> is a finite value (and other conditions are the 
same as in the case of Fig. 11). The terminal point of the vector (kik 2 *c) reciprocates on a line segment 
LN b . The line segments LN a and LN 5 are different in direction and length. 
io In Figs. 11 to 14, the ellipses ELi and El_2 are shown in the same size and direction. The sizes and 
directions of the ellipses ELi and ELj change variously according to the values of the angles 0i, 0 2 , A0i, 
A0 2 shown in Figs. 4 and 5. However, the properties shown in Figs. 11 to 14 are maintained in such general 
cases. As described above, since the direction of the vector cT is the same as that of the vector (k,k 2 "c), 
the properties in the preferred embodiment can be generalized as follows: 
15 (1) When the first and second inclined mirrors 41a and 41b rotate with the same number of rotations in 
the same direction, the terminal point of the vector "c travels on an ellipse, and the size of the ellipse 
changes according to the phase difference A*. 

(2) When the first and second inclined mirrors 41a and 41b rotate with the same number of rotations in 
the opposite directions, the terminal point of the vector *c reciprocates on a line segment, and the length 
20 and direction of the line segment change according to the phase difference A*. 

The aforesaid results by the qualitative consideration have been also confirmed by computer simula- 
tions which use the formulas (3) and (4). 

Fig. 15 shows an^example of the simulation results of the rotations in the same direction. The terminal 
point of the vector "c travels on an ellipse, and the size of the ellipse changes according to the phase 
25 difference A^». 

Fig. 16 shows an example of the simulation results of the rotations in the opposite directions. The locus 
of the terminal point of the vector "c draws a line segment, and the length and inclination angle A* of the 
line segment change according to the phase difference A<fr. 

After reflected by the parabolic mirror 36 (Fig. 1), the laser beam LB illuminates on the workpiece. The 
30 change after the reflection also has the similar properties. When the first and second inclined mirrors 41a 
and 41b rotate while the laser torch 7 travels in the B direction along the butted portion 23 of Fig. 3, two 
modes can be selectively used as the locus of the laser beam LB on the butted portion 23. 

One of the modes is a spin mode shown in Fig. 17. The spin mode is achieved by the rotations of the 
first and second inclined mirrors 41a and 41b in the same direction. The laser beam LB spins on the ellipse 
35 relative to the torch 7. When the torch 7 travels in the B direction (in Fig. 3) along the butted portion 23, the 
locus of the laser beam LB is spiraled. A pitch p t of the spiral locus (hereinafter referred to as a spin pitch) 
is determined by the ratio of the number of rotations Ni ( = N 2 ) to the travelling speed of the torch 7. A 
width Wi of the spiral locus (hereinafter referred to as a spin diameter) changes depending on the rotation 
phase difference A$. 

40 The other is a scan mode shown in Fig. 18. The scan mode is achieved by the rotations of the first and 
second inclined mirrors 41a and 41b in the opposite directions. The laser beam LB scans on the line 
segment relative to the torch 7. The locus of the laser beam LB when the torch 7 travels in the B direction 
is wavelike. A pitch p2 of the wavelike locus (hereinafter referred to as a scan pitch) is determined by the 
ratio of the number of rotations Ni (= N 2 ) to the travelling speed of the torch 7. A width W 2 of the wavelike 

45 locus (hereinafter referred to as a scan width) changes depending on the rotation phase difference A<f>. 

The welding of the workpieces 21 and 22 by weaving can be performed in the desired mode by 
selecting the weaving mode from the two modes and providing the command values of the rotation 
direction, the numbers of rotations Ni, N 2 and the rotation phase difference A* corresponding to the 
selected mode. When the numbers of rotations Ni , N 2 and the rotation phase difference A* are not fixed 

so but are changed according to the travelling direction of the torch 7, the spin diameter Wi and the scan 
width W 2 can be made approximately constant independently on the change in the travelling direction of the 
torch 7. 

Since it is unnecessary to fluctuate the torch 7 itself, the weaving in the two modes can be performed at 
high speed. Since the parabolic mirror 36 is neither rotated nor fluctuated, the weaving does not cause the 
55 increased size of the portion adjacent to the torch 7 and complicated mechanisms. 
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(E) Another Structure of Robot 

Fig. 19 shows another structure for the optical arrangement. In this example, the first and second 
inclined mirrors 41a and 41b are mounted in a laser oscillating unit 80. Before the laser beam LB enters the 
5 arm of a robot RB1, the laser beam LB is periodically deflected. As a result, only a fixed mirror 37 should 
be disposed in the lift body 3, so that the weight of a movable portion of the robot RB can be prevented 
from increasing. 

(F) Method of Controlling Mirrors 

10 

It has been described above that the weaving of the laser beam LB in the spin or scan mode can be 
achieved by the combinations of the number of rotations N,, N 2 and rotation directions of the first and 
second inclined mirrors 41a and 41b and the rotation phase difference A<t> therebetween. Description will be 
given hereinafter on a method of controlling the first and second inclined mirrors 41a and 41b for the 
is weaving of the laser beam LB in the predetermined mode along a predetermined weld line on the 
workpiece. 

Fig. 20 schematically illustrates an optical system of a laser robot RB2 which has the optical 
arrangement similar to the laser robot RB1 of Fig. 19 and the degrees of freedom of respective drive 
portions of the robot RB2. A beam weaver 10 is a unit corresponding to the optical system excluding the 

20 laser oscillator 8 from the laser oscillating unit 80 of Fig. 19 and constitutes the nucleus of the light beam 
deflector. The laser beam LB which enters the beam weaver 10 is reflected in series by the first and second 
inclined mirrors 41a and 41b and a fixed mirror M1 to be introduced to the body of the laser robot RB2. The 
optical path of the laser beam LB is shown in Fig. 20 on the assumption that the first and second inclined 
mirrors 41a and 41b are not rotating. The laser beam LB is further reflected in series by fixed mirrors M2 to 

25 M4 mounted in the body of the robot RB2 to be introduced to the tip of the torch 7, as described above. 

In Fig. 20. similarly to Fig. 2. a Cartesian coordinate system xyz is defined on the base 1. The 
revolution angle of the revolving column 2 on the revolution axis z is represented by an angle 0. The pivot 
angle of the first pivotal body 5 supported at the leading edge of the horizontal arm 4 on the axis Y is 
represented by an angle or. The pivot angle of the second pivotal body 6 on the axis V is represented by an 

30 angle 

It is apparent from Fig. 20 that the mirrors M2 to M4 themselves are fixed and do not rotate. However, 
by the revolution of the revolving column 2, the mirror M2 is made to revolve at the angle 0. Assuming that 
the laser beam LB emitted from the beam weaver 10 is not periodically deflected, the planes of incidence of 
the laser beam LB reflected by the mirror M1 on the mirror M2 are different depending on processing 

35 points. The directions in which the laser beam LB is reflected from the mirror M2 are accordingly different 
depending on the processing points. The same is true for the mirrors M3 and M4. For determining the 
direction in which the laser beam LB is emitted from the tip of the torch 7, consideration must be given to 
not only the periodical deflection that the laser beam LB is subjected to when passing through the beam 
weaver 10 but also the influences of the revolution of the mirror M2 and the pivots of the mirrors M3 and 

40 M4 with the travel of the torch 7 along the weld line. This means that, for accurate control of the motors 42a 
and 42b (not shown in Fig. 20) of the first and second inclined mirrors 41a and 41b in the beam weaver 10, 
the command values to be applied to the motors 42a and 42b must be determined by the informations of 
the weld line and welding conditions including the influences of the revolution of the mirror M2 and the 
pivots of the mirrors M3 and M4. However, since the handlings of the influences are different depending on 

45 the weaving mode of the laser beam LB, the methods of controlling the mirrors in the spin and scan modes 
will be discussed separately. 

(i) Method of Controlling Mirrors in Spin Mode 

so In the spin mode shown in Fig. 17, there is no need to consider the influences of the mirrors M2 to M4 
because the laser beam LB scans while drawing the spiral locus along the weld line (corresponding to the 
butted portion 23 of Fig. 3) on the workpiece. The command values for controlling the motors 42a and 42b 
are uniquely determined by the informations (the spin diameter and the like) of the locus and the travelling 
speed of the torch 7. 

55 Fig. 21 schematically illustrates the scanning of the laser beam LB along the weld line I while drawing 
the spiral locus on the workpiece. Points P jf P l+1 , P i+2 are processing points which are subjected to 
teaching, and a point P, is an interpolated processing point. In Fig. 21, the torch 7 is moving from the point 
Pi to the next point P t * ^ . 

12 

BNSDOCID: <EP 0483365A1 I > 





EP 0 483 385 A1 



The welding speed of the laser robot RB2 is represented by a speed v, the spin diameter is 
represented by the reference character d, and the spin pitch is represented by the reference character pi . 
The first and second inclined mirrors 41a and 41b are equal in rotation direction and in the number of 
rotations in the spin mode. The spin pitch pt is the distance the laser beam LB is scanned on the workpiece 
during one rotation of the first inclined mirror 41a. Accordingly, the numbers of rotations Ni and N 2 of the 
mirrors 41a and 41b are expressed by: 

Nt = N 2 = V/p, (10) 

The rotation phase difference A<t> is approximately expressed by: 



where A01 and A0 2 are the inclination angles (see Fig. 5) of the first and second inclined mirrors 41a and 
41b, respectively, and f 0 is the focal length of the mirror M4 (corresponding to the parabolic mirror 36 of 
Fig. 19). The angles A01 , A0 2 and the length f 0 are constant. Hence, the rotation phase difference A* can 
be uniquely determined by the designation of the spin diameter d. 

The derivation of the formula (11) will be described below. For this purpose, it is assumed that the first 
and second inclined mirrors 41a and 41b are ideally, sufficiently spaced apart from each other to the extent 
that the angles 01 and 0 2 of the mirrors are approximately equal to zero. On this assumption, it is 
considered that both loci of the laser beam LB reflected by the first and second inclined mirrors 41a and 
41b draw circles. 

Ftg. 22 shows the loci of the laser beam LB under these conditions. For simplification, it is assumed in 
Fig. 22 that the inclination angles A01 and A0 2 of the mirrors 41a and 41b are equal as mentioned above. 

In Fig. 22, a circle Co indicates the locus of the laser beam LB reflected by the first inclined mirror 41a, 
and corresponds to the locus of the terminal point of the vector (-kib) shown in Fig. 9. The locus of the 
laser beam LB reflected by the second inclined mirror 41b draws a circle Ci where the position of the laser 
beam LB reflected by the first inclined mirror 41a on the locus is a point d when the rotation phase of the 
first inclined mirror 41a is zero. When the rotation phase of the second inclined mirror 41b is also zero, the 
position of the laser beam LB reflected by the second inclined mirror 41b on the locus is a point Ai. The 
position of the laser beam LB reflected by the second inclined mirror 41b on the locus travels on the circle 
C1 depending on degree of the lag or lead of the rotation phase of the second inclined mirror 41b. 

A circle C2 indicates the locus of the laser beam LB reflected by the second inclined mirror 41b where 
the rotation phase of the first inclined mirror 41a is $1 (where a center O2 is the position of the laser beam 
LB reflected by the first inclined mirror 41a on the locus). The position of the laser beam LB on the locus 
where the rotation phase of the second inclined mirror 41b is zero is a point A2. Similarly, the position of the 
laser beam LB on the locus travels on the circle C2 depending on degree of the lag or lead of the rotation 
phase of the second inclined mirror 41 b. A circle C 3 indicates the locus of the laser beam LB reflected by 
the second inclined mirror 41b where the rotation phase of the first inclined mirror 41a is larger than the 
phase <fri . A point A3 is the position of the laser beam LB on the locus when the rotation phase of the 
second inclined mirror 41b is zero. 

When the rotation phase difference A<fr between the first and second inclined mirrors 41a and 41b is 
zero, the locus of the laser beam LB reflected by the second inclined mirror 41 b is the circle Ct having a 
center O and a radius OA } . The laser beam LB which is deflected so that its locus draws the circle Ci is 
condensed by the mirror M4 and, subsequently, is scanned on the workpiece to draw the spiral locus. That 
is, the radius OA1 of the circle Ci correspondsto the spin diameter d. Thus a spin diameter do where the 
rotation phase difference A^> is zero is expressed by: 

do/2 = 2(Afli +A0 2 )fo (12) 

Based on the foregoing description, the case where the rotation phase difference A* between the first 
and second inclined mirrors 41a and 41b is not zero will be considered. Assuming that the rotation phase of 
the first inclined mirror 41a is zero and the rotation phase of the second inclined mirror 41b lags behind by 
the phase A* relative to the rotation phase of the first inclined mirror 41a, the position of the laser beam LB 




(11) 
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reflected by the second inclined mirror 41b on the locus is a point B, shown in Fig. 22. The locus of the 
laser beam LB reflected by the second inclined mirror 41b draws a circle having a center O and a radius 
OBi . The spin diameter d is expressed by: 

d/2 = 2(A6i +Ae 2 )fo cos(A<*>/2) (13) 

In the practical robot, for convenience, the rotation phase difference A* is treated as: 
A£ = 7T-A<f> (14) 

When the formula (13) is expressed by the use of the formula (14), the formula (15) for the spin diameter d 
is obtained. 

d/2 = 2(A0t +Afl 2 )f 0 sin(A</>/2) (15) 



When the formula (15) is solved for the rotation phase difference A*, the formula (11) is obtained. 

Hereinabove described are the relationships and principle which are the basis of the method of 
controlling the first and second inclined mirrors 41a and 41b for weaving of the laser beam LB in the spin 
mode. Next discussed are steps for controlling the first and second inclined mirrors 41a and 41b in the 
20 practical robot on the basis of the principle. 

In advance, the structure of the control system of the laser robot RB2 is again considered with 
reference to Fig. 23. Fig. 23 is a block diagram of the control system. All of the units but a teaching box 54 
are controlled by the command values of the robot controller 52 through a bus 56. The teaching box 54 is 
an input unit for inputting teaching data and the specified values of various welding conditions such as the 
25 spin diameter d to the robot controller 52. The robot controller 52 includes a CPU 52a and a memory 52b. 
The memory 52b stores the specified values transmitted from the teaching box 54 and the results of the 
playback calculated in the CPU 52a, etc. 

Based on the above-mentioned preparation, the control procedure of the laser robot RB2 for weaving in 
the spin mode will be described later. 
30 Figs. 24 to 26 are a flow chart of the control procedure of the laser robot RB2. 

In the step SI, various parameters for weaving in the spin mode are specified and inputted. The 
specified values of the spin pitch p, , spin diameter d and initial phase command value fa of the first 
inclined mirror 41a are inputted by the teaching box 54. These data are stored in the memory 52b through 
the bus 56. 

35 In the step S2, teaching is performed. As a result, the teaching data (Cartesian coordinates X, and joint 
coordinates a, of the teaching points P § ) given from the teaching box 54 are stored in the memory 52b. It is 
assumed that the number of teaching points Pj is n (i = 1 to n). 

In the step S3, welding speeds Vj at the respective teaching points Pj are specified and inputted by the 
teaching box 54 together with the teaching, and are stored in the memory 52b. 

ao In the step S4, the playback (interpolation calculation) is performed as a function of the teaching data of 
the step S2. The Cartesian coordinates Xy of the interpolated points P y (the j-th interpolated points from the 
point Pj between the teaching points Pj and P i+1 ) are determined by interpolation. The interpolated values 
are inversely converted so that the joint coordinates a Xl of the points Pjj are calculated by the CPU 52a to be 
stored in the memory 52b. For convenience, it is assumed that the number of interpolated points P fi is m 

45 (j = 1 to m). * 

In the step S5, the initial phase command values <*m and <t> 2 of the first and second inclined mirrors 41a 
and 41b are calculated, respectively. (The initial phase command value fa has been already given in the 
step S1.) That is, the CPU 52a reads out the specified value of the spin diameter d from the memory 52b to 
calculate the rotation phase difference A* between the mirrors 41a and 41 b from the formula (11). From the 
so calculated rotation phase difference A* and the initial phase command value fa of the first inclined mirror 
41 a which is read out from the memory 52b, the initial phase command value <t> 2 of the second inclined 
mirror 41 b is determined by: 



55 



<J> 2 = fa-&4> (16) 

to be stored in the memory 52b. 
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On completion of the above-mentioned preparation, the procedure of practically driving the laser robot 
RB2 is carried out. In the steps S6 and S7, the tip of the torch 7 of the laser robot RB2 is moved to the first 
teaching point Pi . This is achieved by applying a command signal D x1 of the joint coordinate en of the first 
teaching point Pi stored in the memory 52b to an arm drive motor 55 by the robot controller 52 to 

5 resultingly revolve and pivot the arms. For generalization of the following description, the first teaching point 
Pi is replaced with the teaching point P t in the step S6. 

In the step S8, the numbers of rotations N 1if N 2 , of the first and second inclined mirrors 41a and 41b at 
the teaching point Pj are calculated. Since the welding speed V } for the teaching point P* has been already 
specified in the step S3, the CPU 52a reads out necessary data from the memory 52b to determine the 

io numbers of rotations N 1if N 2i from the formula (17). 

N,i = N 2 , = Vj/p, (17) 

In the step S9, the numbers of rotations N„, N 2 , of the first and second inclined mirrors 41a and 41b at 

75 the teaching point P, f the initial phase command values <fn, </> 2 and a rotation direction command value DS 
(a signal indicative of the same direction) are transmitted from the robot controller 52 to the motor controller 
51. The motor controller 51 converts the transmitted command values into motor drive powers D,,, and 
outputs them to the motors 42a, 42b, respectively. At this time, the robot controller 52 outputs an ON signal 
to the laser oscillator 8, so that the laser beam LB oscillates. As a result, the laser beam LB is periodically 

20 deflected so that its locus draws an ellipse by the first and second inclined mirrors 41a and 41b which are 
subjected to the powers Dn. to make predetermined rotations. 

In this state, the tip of the torch 7 is moved to the first interpolated point P n (in the steps S10 and S11). 
A command value Dxn of the joint coordinate a|1 of the interpolated point P M is transmitted from the robot 
controller 52 to the arm drive motor 55. so that the torch 7 travels along the weld line i to th« interpolated 

25 point P M . This accomplishes the weaving of the laser beam LB in the spin mode between the teaching point 
Pi and the interpolated point P n . For convenience, the interpolated point Pi, is replaced with the interpolated 
point Py in the step S10 to generalize the following description. 

In the step S12, a welding speed V n and the numbers of rotations N^j, N 2ij of the first and second 
inclined mirrors 41a, 41b at the interpolated point P u to which the torch 7 is moved are calculated. Various 

30 methods of calculating the welding speed V 0 at the interpolated point P Q are employable depending on the 
type of interpolation, for example, linear interpolation between the respective teaching points P» and 
interpolation by a curve like a parabola. As an example, interpolation between two teaching points Pj and 
Pi + i by a curve SC shown in Fig. 27 is considered in this preferred embodiment. To avoid complicated 
description, it is supposed that the welding speed at each interpolated point P, is determined by the 

35 travelling distance of the torch 7 between two adjacent interpolated points. Assuming that the laser robot 
RB2 is set so that the travelling time of the tip of the torch 7 between the interpolated points P n and P jj+1 is 
a constant value At, the welding speed Vy at the single interpolated point P n is given by the formula (18) by 
the use of the position vectors 



40 




and X. . 



in the Cartesian coordinate system at the interpolated points Py and P t 
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V. 




(18) 
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Similarly, the welding speed V jj + 1 at the next interpolated point P^, is given by: 
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+ 1 



(19) 
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The welding speeds V u at all of the Interpolated points between the two points Pj and P^, can be 
determined by the aforesaid procedure. A welding speed V im at the last interpolated point P lm is determined 
by the formula (20) by the use of the position vectors 

X. > and X * 
am a + 1 



in the Cartesian coordinate system at the interpolated point P im and the next teaching point P i+1 . 

70 



am 
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X.^ -X. 
a + 1 im 



At 



(20) 



Description is given again on the step S12 based on the aforesaid description. The CPU 52a reads out 
the position data Xy and X^, of the interpolated points P u and P ij+1 from the memory 52b to calculate the 
welding speed Vjj at the interpolated point P H by the formula (18). The CPU 52a further reads out the 
20 specified value of the spin pitch pi from the memory 52b to calculate the numbers of rotations N^, at 
the interpolated point Py by the following formula: 



Nuj = N 2lj = Vy/pi (21) 

25 On determination of the numbers of rotations N Vli and iNfey at the interpolated point P 5 . the motor drive 
powers D Ui and O^n are applied to the motors 42a and 42b respectively in the same procedure as the step 
S9 (in the step S13). When the interpolated point P fj is not the last interpolated point P im (in the step S14). 
the tip of the torch 7 is moved to the next interpolated point P ij + 1 On the steps S15 and s11), so that the 
weaving of the laser beam LB is performed in the spin mode between the interpolated points P n and P ij+1 . 

30 Until the tip of the torch 7 reaches the last interpolated point P^, the procedure of the steps S1 1 to S13 is 
repeated (in the step S14). As a result, this accomplishes the weaving of the laser beam LB between all of 
the interpolated points (points P M to P im ) along the weld line t with the predetermined spin pitch & and 
spin diameter d maintained. 

In the steps S16 and S17, it is judged whether or not the next teaching point P j + 1 is the last teaching 

35 point P n to which the tip of the torch 7 is to be moved. When it is not judged that the teaching point P i+1 is 
the teaching point P n , the tip of the torch 7 is moved to the next teaching point P i+1 (in the step S7). Thus 
the welding by weaving between the teaching points P, and P l+1 is earned out by the laser beam LB. 

A series of steps are executed until the tip of the torch 7 reaches the last teaching point P n (in the step 
S17). When the tip of the torch 7 reaches the point P„ (in the step S18), the weaving in the spin mode along 

40 the weld line I is completed. 

In the foregoing description, the numbers of rotations N lh N 2i and N ljjf Nag are determined after the 
determination of the welding speeds V, and for each processing point i.e., for each teaching point P> and 
interpolated point P Vl , however, the present invention is not limited to this. The numbers of rotations Nt and 
N 2 may be calculated on the assumption that the welding speeds Vj at all of the processing points are 

45 approximately equal, depending on the welding conditions, for example, in the linear interpolation between 
the respective teaching points P t . It is also practical to calculate the numbers of rotations N tij and ISfeij on the 
assumption that the welding speeds V Sj at the respective interpolated points P i} are approximately equal to 
the welding speed Vj at the preceding teaching point P>. 



50 (ii) Method of Controlling Mirrors in Scan Mode 



In the scan mode shown in Fig. 18, it is preferable that a beam spot SPi of the laser beam LB on the 
workpiece is constantly in the direction perpendicular to the weld line 1 as shown in Fig. 28. (The direction 
of the beam spot SP f on the workpiece as viewed from the processing point P s on the weld line i 
55 corresponds to an oscillation direction £ of the laser beam LB.) It is a normal practice in the laser welding to 
teach that the torch 7 should be positioned in the direction perpendicular to the surface of the workpiece in 
the teaching step before the laser welding step. A welding speed vector v of the torch 7 is tangential to the 
weld line I . It is considered that the oscillation direction E is suitably in the direction perpendicular to the 
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vector v and a torch vector *? 0 which is parallel to the axis W of the torch 7. (A vector w is also defined in 
the same direction.) Such situations are schematically, conceptually illustrated in Fig. 29, which shows the 
joint coordinates 8, a. 0 of the laser robot RB2 and positional relation between the torch vector "a* 0 and the 
processing point Pj. 

To constantly maintain the torch vector "a* 0 perpendicularly to the vectors v and w, it is necessary to 
compensate for the influences of the revolution of the mirror M2 and the pivots of the mirrors M3 and M4. 
That is, it is necessary to determine the control command values of the motors 42a and 42b by the welding 
conditions (welding speed and the like), information (the vector w) of the weld line 1 and the drive amounts 
(angles 0, a, fi) of the arms of the robot RB2. 

The numbers of rotations N, and N 2 of the first and second inclined mirrors 41a and 41b at the 
predetermined time can be treated in the similar manner as in the spin mode. By the use of the welding 
speed vector v and scan pitch pa of the torch 7 at the predetermined time, the numbers of rotations N, and 
N 2 are expressed as: 



75 Ni = N 2 = V/p2 (22) 

On the basis of the aforesaid respects, consideration is given to how the oscillation direction Z of the 
laser beam LB is adapted to be constantly in the direction of the vector w at the processing point Pi. This 
consideration corresponds to the discussion of the method of controlling the rotation phase difference A$ 

20 between the mirrors 41a and 41b. For this purpose, it is essential to determine the direction in which the 
laser beam LB should be deflected (oscillated) at the outlet of the beam weaver 10. Accordingly, it is 
necessary to trace back changes in the oscillation direction of the laser beam LB from the processing point 
Pi toward the outlet of the beam weaver 10. 

As a simple case, considered is the change in the oscillation direction of the laser beam VB after 

25 reflection where the laser beam LB oscillating in a direction is incident at 45* on a revolving or pivoting 
arbitrary mirror Mj, with reference to Figs. 30 and 31 separately. 

Referring to Fig. 30. a laser beam IL oscillating on a straight line which is in the x^ plane and is 
inclined at an angle $ from the * axis is incident on the fixed mirror Mj. A coordinate system expressive of 
the incident beam IL is defined such that the z } axis is in the direction in which the incident beam IL travels, 

30 the x, axis is perpendicular to the incident beam IL and a reflected beam RL, and the y< axis is 
perpendicular to the Xj and Zj axes. A coordinate system expressive of the reflected beam RL, which has 
Xi + i. yi*i. 2i +1 axes, is obtained by rotating the coordinate system expressive of the incident beam IL by 
90* on the x t axis so that the z i + 1 axis is in the direction in which the reflected beam RL travels. In the 
definition of the two coordinate systems, the reflected beam RL oscillates on a straight line which is in the 

35 Xj^yi+T plane and is inclined at an angle -$ from the x i+1 axis. 

Referring to Fig. 31, the incident beam IL oscillating on the x, axis is incident on the mirror Mj revolving 
or pivoting on the Zj axis at an angle 0,. The coordinate systems expressive of the incident beam IL and 
reflected beam RL are the same as those of Fig. 29. The reflected beam RL oscillates on a straight line 
which is in the x i + 1 y i+1 plane and is inclined at the angle 0 r . 

40 In the combination of the cases of Figs. 30 and 31, that is, in the case where the laser beam LB 
oscillating at the angle 6 is reflected by the mirror Mi revolving or pivoting at an angle 0 rf , an oscillation 
direction 0j (an angle of inclination from the x i + 1 axis, which represents the oscillation direction of the laser 
beam LB hereinafter) is given by: 



45 $i = -0 + 0 ri (23) 

When the laser beam LB reflected by the mirror M 4 is further reflected by the next mirror M i+1 - 
(revolving or pivoting at an angle 0 ri *i), it is apparent that an oscillation direction 0 i+1 after reflection is: 

= (- 1 > 2 ^ + (~D^ ri + ^ ri + 1 (24) 

In general, when the laser beam LB oscillating in an oscillation direction ¥ w is incident on an optical 
system including m-number of mirrors Mj revolving or pivoting at the angle 0 rit it is found that the oscillation 
direction * of the laser beam LB reflected by the m-th (last) mirror M m is expressed by: 



50 



55 
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* = <-ir*W + <-1) m ' , *r1+ +(-1) 0 *rm (25) 



5 The consideration results are applied to the laser robot RB2. Fig. 32 illustrates coordinate systems for 

the laser beam LB which is propagated while oscillating in the scan mode in the optical system of the laser 
robot RB2. The coordinate systems are arranged in accordance with the method of defining the coordinate 
system of Fig. 28. In the laser robot RB2, since the mirror Ml neither revolves nor pivots, the oscillation 
direction * can be obtained by substituting m = 4 and 0 r1 =0 in the formula (25). When the angles 6&, 

w 6 v4 are replaced with angles 8, a, 0, respectively, the oscillation direction * can be given by: 

* = * w + e-a + £ (26) 



By using the torch vector "a 0 and the welding speed vector v at the predetermined time, the vector w 
75 can be expressed as: 



-> a o xV 
w = 



20 



|a Q xV | 



(27) 



Since the torch vector "a* 0 has a magnitude corresponding to the length 1 2 of the torch 7 and a direction 
perpendicular to the direction of the welding speed voctor v, the vector w can be determined from the 
25 formula (27) by the determination of the magnitude and direction of the welding speed vector v. 

In Fig. 32. a coordinate system expressive of the laser beam LB reflected by the mirror M4 is defined 
such that the z* axis is parallel to the torch vector *a* 0 and the y* axis is parallel to a vector EF which 
connects the center E of the mirror M3 and the center F of the mirror M4. 

The Cartesian coordinates_of the points E and F, that is, the components of the vector "e (Xe, y e , Ze) and 
30 the components of the vector T (x f , y f , z,) (see Fig. 29) are expressed in the joint coordinates (9, Y, Z, a, £) 
as described below. 

The components of the vector IT are respectively given by: 

^ = (Y + Y 0 )cos9 (28) 

35 

y e = (Y + Y 0 )sin9 (29) 

Ze = Z (30) 

40 where the constant Y 0 is an offset value. 

Since the magnitude of the vector EF is I 1t the components of the vector T are in the following relation 
to those of the vector "e . 

x, = Iisina*sin9 + Xe (31) 

45 

y f = XiSina*cos9 + y e (32) 

Zf = -tiCOSar + Ze (33) 

so Accordingly, a unit vector e? 0 in the direction of the y* axis is: 



e Q = (e-f)/|e-fl ... (34) 

55 

The angle *o formed by the unit vector "e o and the vector w is (see Fig. 33): 
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35 



e 0 = le 0 IIWIcosY 0 . .. (35) 

s The change of the formula (35) by using the formula (36) provides the formula (37). 
cos 2 *o +sin 2 * 0 = 1 (36) 



10 



75 



55 




20 



25 



••• (37) 

The formula (37) is solved for the angle * 0 as follows: 

(38) 




The oscillation direction ♦ to be found is: 
* = W2-* 0 (39) 

30 From the formulas (26) and (39), the oscillation direction * w of the laser beam LB emitted from the 
beam weaver 10 is: 



The changes in the oscillation direction of the laser beam LB are traced back from the processing point 
40 Pj toward the outlet of the beam weaver 10. As a result, it is found that the oscillation direction * w of the 
laser beam LB at the outlet of the beam weaver 10 is uniquely determined by the arm joint coordinates of 
the processing point P x and the welding speed v which is calculated from the Cartesian coordinates of the 
processing point Pj. Below considered is relation between the oscillation direction * w of the laser beam LB 
and the rotation phase difference A<£ between the first and second inclined mirrors 41a and 41b. 
45 There is shown in Fig. 34 relation between a coordinate system (xx, yy, zz) expressive of the laser 
beam LB propagated in the beam weaver 10 and the oscillation direction ¥ w of the Isser beam LB. The first 
and second inclined mirrors 41a and 41b rotate in the CCW and CW directions respectively (see Rgs. 7 
and 8) with the rotation phase difference A$. When the rotation phase difference A</> is at zero degree, the 
laser beam LB oscillates on the xx axis in the xxyy plane. As the rotation phase difference A<£ increases, 
so the oscillation direction ¥ w of the laser beam LB changes by an angle A<£/2 in the CW direction. 
The rotation phase difference A<p to be finally found is: 

A* = 2V W 



= 2(/T/2-V o -0+a-/3) ... (41) 
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The flow for determining the rotation phase difference A<j> by using the aforesaid formulas in the scan 
mode is shown in Fig. 35. In Fig. 35, * mark indicates the Cartesian coordinates obtained from the teaching 
data, - mark indicates the joint coordinates obtained from the playback, and numerals in parentheses 
designate formula numbers. 

5 Hereinabove described is the principle of the control method for weaving with the predetermined 

welding conditions satisfied in the scan mode. 

Figs. 36 to 38 are a flow chart of the procedure for controlling the laser robot RB2 on the basis of the 
principle. The procedure for controlling the laser robot RB2 in the scan mode is basically similar to that for 
controlling the laser robot RB2 in the spin mode, except that the rotation phase difference A<£ is uniquely 

w determined by the spin diameter d in the spin mode while the numbers of rotations Ni, N2 and the rotation 
phase difference A$ are required to be determined for each processing point in the scan mode. The steps 
SS8 and SS13 of Fig. 37 correspond to the steps for calculating the rotation phase difference A<t>. and A^y 
at the teaching point Pj and interpolated point P n , respectively and, therefore, the initial phase command 
values $11, <£ 2 j and <t>z n . The remaining steps are similar to the corresponding steps in Figs. 24 to 26. 

is Since the description of Figs. 36 to 38 almost overlaps that of Figs. 24 to 26, the details thereof will be 
omitted. 

(G) Modifications 

20 In the present invention, the number of inclined mirrors is not limited. The periodical deflection of the 
laser beam can be achieved generally by the combination of a plurality of inclined mirrors which are 
arranged in series in the optical path. An optical system such as a fixed mirror may be disposed in the 
optical path between the plurality of inclined mirrors. A rotation power source may be common to the 
respective inclined mirrors to rotate them through transmissions. When the individual direct drive motors are 

25 provided as in the preferred embodiment, errors due to backlash and so on can be prevented. 

When the numbers of rotations Ni and N 2 of the first and second inclined mirrors 41a and 41b are 
different from each other, a deflection locus similar to what is called Lissajous's figure can be obtained. In 
general, a periodical deflection locus can be obtained when the ratio of Ni to N 2 is a rational number. 
Various deflection loci can be obtained by changing relation between the angles 0\ and $2 and relation 

30 between the angles A01 and Ae 2 . 

The light beam deflector (corresponding to the beam weaver) of the present invention is employable in 
laser welding robots, laser robots for reforming the surface of the workpiece, and equipments other than 
robots. 

35 Control Signal Generator for Light Beam Deflector 

The novel weaving method of the laser beam using the light beam deflector (beam weaver) is provided 
by the applicant of the present invention. For practical achievement of the light beam deflector, it is 
necessary to electrically control two rotation mechanisms at high accuracy. Requested is a control signal 

40 generator capable of simultaneously rotating the two rotation mechanisms at high speeds while constantly 
holding the predetermined numbers of rotations and a predetermined rotation phase difference in a series of 
continuous operations including start, acceleration, deceleration and stop. A system of such a device 
preferably controls the rotation speeds of the two rotation mechanisms (such as motors) and their positions 
in rotation by a pulse train signal as being used in a stepping motor and the like. 

45 A motor controller as currently being put to practical use and being commercially available either 
controls the stop position of the motor or controls the motor so that the rotation speed of the motor is held 
constantly, and cannot be used as a device for simultaneously controlling the positions and rotation speeds 
of the two motors rotating at high speeds with high exactness. Therefore a novel controller which can 
achieve such control has been strongly required. 

50 The control signal generator for the light beam deflector of the present invention has been made to 
meet the requirement, and can control the two rotation mechanisms which make high-speed continuous 
rotations including a series of operations such as start, acceleration, deceleration and stop so that they 
constantly hold the predetermined numbers of rotations and the predetermined rotation phase difference for 
each predetermined time in the rotations. In long, continuous drives of the two rotation mechanisms, the 

55 control signal generator enables highly exact control in which an error of a single pulse is not generated. 
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(I) Electrical Structure of Control Signal Generator 

Fig. 39 is a block diagram showing an electrical structure of a control signal generator 100 for the light 
beam deflector according to a preferred embodiment of the present invention. To clarify connection 
5 between the control signal generator 100 and the beam weaver 10, the cross section of the beam weaver 10 
is also schematically shown in Fig. 39. It can be said that the light beam deflector is composed of the 
control signal generator 100 for the light beam deflector and the beam weaver 10. 

In Fig. 39, the laser beam incident on the beam weaver 10 is designated by LBi, and the laser beam 
after the serial reflections by the rotating first inclined mirror 41a, rotating second inclined mirror 41b and 
ro the fixed reflecting mirror Ml is designated by LBr. There is shown also in Fig. 39 an optical path of the 
laser beam LBi where both of the first and second inclined mirrors 41a and 41b do not rotate but stay still. 

The first motor 42a in the first rotation mechanism 40a and the second motor 42b in the second rotation 
mechanism are servomotors. In the following description, the first and second motors 42a and 42b are 
referred^o as first and second servomotors 42a and 42b. 
75 In Fig. 39, a timing pulse generation circuit 130 generates a second timing pulse signal CL2 having 2"- 
number of pulses during a predetermined time interval At {hereinafter referred to as a unit time At). The 
timing pulse generation circuit 130 includes a counter circuit 131 having the data length of N bits. The 
counter circuit 131 counts the number of pulses of the second timing pulse signal CL2 to generates a single 
pulse each time the counted number becomes 2 N , that is, for each unit time At. The signal composed of the 
20 pulses is transmitted as a first timing pulse signal CL1 from the timing pulse generation circuit 130 to a 
controller 110 and a microprocessor 120 described later. 

The output portion of the controller 110 is connected to the input portion of the microprocessor 120. 
The controller 110 executes a predetermined calculation by the first timing pulse signal CL1 generated in 
the timing pulse generation circuit 130. One of the output portions of the microprocessor 120 is connected 
25 to the input portion of a first pulse train formation circuit 140, and the other output portion thereof is 
connected to the input portion of a second pulse train formation circuit 150. The operation of the 
microprocessor 120 is controlled by the first timing pulse signal CL1. The operations of the first and second 
pulse train formation circuits 140 and 150 are controlled by the first and second timing pulse signals CL1 
and CL2 generated in the timing pulse generation circuit 130. 
30 The output portion of the first pulse train formation circuit 140 is connected to the input portion of the 
first servomotor 42a in the beam weaver 10 through a first servo-amplifier 160. The output portion of the 
second pulse train formation circuit 150 is connected to the input portion of the second servomotor 42b in 
the beam weaver 10 through a second servo-amplifier 170. The pulse train signals can be inputted to the 
first and second servo-amplifiers 160 and 170, which include deviation counters. 
35 Fig. 40 is a block diagram showing a detailed electrical structure of the first and second pulse train 
formation circuits 140 and 150 and flows of various signals, with the microprocessor 120 and the timing 
pulse generation circuit 130. 

With reference to Fig. 40, the first pulse train formation circuit 140 includes upper and lower command 
buffers 141, 142, an adder 143 and an accumulator 144. One of the output portions of the microprocessor 
40 120 is connected to the input portion of the upper command buffer 141. The input portion of the lower 
command buffer 142 is connected to the output portion of the upper command buffer 141. The operation of 
the lower command buffer 142 is controlled by the first timing pulse signal CL1. One of the input portions of 
the adder 143 is connected to the output portion of the lower command buffer 142. The command buffers 
have the two-stage structure, the upper command buffer 141 and the lower command buffer 142, so that the 
45 upper command buffer 141 may receive a command signal outputted from the microprocessor 120 while 
calculations of addition are executed by the adder 143. accumulator 144 and lower command buffer 142 
during the unit time At. 

One of the output portions of the adder 143 is connected to the input portion of the accumulator 144. 
The output portion of the accumulator 144 is connected to the other input portion of the adder 143. The 

so adder 143 and accumulator 144 form a loop for calculations of addition. The accumulator 144 outputs the 
holding data to the adder 143 as one of the input signals of the adder 143 in synchronism with the second 
timing pulse signal CL2. To the other input portion of the accumulator 144 is directly connected the output 
portion of the microprocessor 120 which is also connected to the input portion of the upper command buffer 
141, in order to set the accumulation results of the accumulator 144 to zero in the initial state of the 

55 calculations of addition. The number of digits of the adder 143 is N bits. Each time its addition results 
become integer multiples of 2 N , the adder 143 outputs one pulse for carrying (a signal f,) from one of its 
output portions. 
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The second pulse train formation circuit 150 has the same structure as the first pulse train formation 
circuit 140, and includes upper and lower command buffers 151, 152, an adder 153 and an accumulator 
154. The operations of the first and second pulse train formation circuits 140 and 150 are controlled by 
common timing signals, that is, the first and second timing pulse signals CL1 and CL2, in order to 
5 accurately control the rotation phase difference between the servomotors 42a and 42b. 

(II) Operation of Control Signal Generator 

Fig. 41 is a timing chart chronologically showing the operations of signal processings in the respective 

w components until the pulse train signal fi is produced by the first pulse train formation circuit 140. In Fig. 
41, (a) shows the start and end of the calculation processing executed in the controller 110 with respect to a 
time axis T; (b) and (0 show the waveforms of the first and second timing pulse signals CL1 and CL2, 
respectively; (c) shows the start and end of the first calculation processing which the microprocessor 120, 
on receiving the calculation results (N, A$) in the controller 110, gives as a first calculation result APt to the 

75 first pulse train formation circuit 140; (d) shows the start at which the upper command buffer 141 reads the 
first calculation result APi from the microprocessor 120 and a period of time during which the upper 
command buffer 141 stores the result APi ; (e) shows the start at which the lower command buffer 142 
reads the first calculation result APi from the upper command buffer 141 and a period of time during which 
the lower command buffer 142 stores the result AP t ; (g) shows the start of the calculation of addition in the 

20 adder 143 and accumulator 144 and the calculation time thereof; and (h) shows the production of the first 
pulse train signal fi in accordance with the addition results. For each unit time At corresponding to the 
cycle of the first timing pulse signal CL1, the microprocessor 120 executes the first calculation to output a 
new first calculation result (APifc. and. in parallel therewith, the adder 143 and accumulator 144 execute the 
calculations of addition as a function of the previous first calculation result (APi )u to output pulses the 

25 number of which is equal to the first calculation result (APi \.t- 

Fig. 42 is a timing chart similar to Fig. 41 in relation to the production of a second pulse train signal f 2 . 
In Fig. 42. (c) shows the start and end of the calculation of a second calculation result AP 2 which the 
microprocessor 120 gives to the second pulse train formation circuit 150; (d) shows the start at which the 
upper command buffer 151 reads the second calculation result AP 2 and a period of time during which the 

30 upper command buffer 151 stores the result AP 2 ; (e) shows the start at which the lower command buffer 
152 reads the second calculation result AP 2 from the upper command buffer 151 and a period of time 
during which the lower command buffer 152 stores the result AP 2 ; (g) shows the start and end of the 
calculations of addition in the adder 153 and accumulator 154; and (h) shows the waveform of the second 
pulse train signal f 2 produced in accordance with the calculations of addition. In Fig. 42, (a), (b) and (0 are 
35 the same as those in Fig. 41, respectively. The details of the operation of the control signal generator 100 
will be hereinafter described in the descending order of components with reference to Figs. 41 and 42. 

(a) Operation in Controller 

40 The controller 110 calculates the numbers of rotations Ni , H2 of the first and second servomotors 42a, 
42b and the rotation phase difference A<t> between the servomotors 42a and 42b in accordance with a 
predetermined algorithm. The predetermined algorithm is a calculation rule that determines the numbers of 
rotations N1 , tsfe and the rotation phase difference A<t> such that the laser beam LB, outputted from the 
beam weaver 10 is periodically deflected in the desired mode. 

45 In the application of the beam weaver 10 to the laser robot RB, RB1 or RB2, for example, the controller 
110 calculates the numbers of rotations N1 , and the rotation phase difference A<t> from the formulas (10) 
and (11) for the weaving of the laser beam LB in the spin mode. In this case, the numbers of rotations N1, 
N 2 are calculated from the formula (1) for each processing point P t (teaching point and interpolated point) 
on the weld line, and the rotation phase difference A<*» is uniquely determined by the designation of the spin 

50 diameter d and need not be calculated for each processing point Pi. 

For the weaving of the laser beam LB in the scan mode, however, the numbers of rotations N1 , N2 and 
the rotation phase difference A<t> must be determined for each processing point P,. Thus the controller 110, 
in general, calculates the numbers of rotations N1 , fvfc and the rotation phase difference A* for each time 
Ato during which the tip of the torch 7 travels from the processing point Pj to the next processing point P i+1 . 

55 In the present invention, the unit time At of the control signal generator 100 must be equal to or less than 
the travelling time Ato (indicative of a command interval where the main controller of the laser robot RB 
itself sends a drive command signal to the respective arms). 



22 



BNSOOCID: <EP Q483385A1 J > 



EP 0 483 385 A1 



In the preferred embodiment shown in Fig. 39. the controller 110 calculates the numbers of rotations 
N,, N 2 of the first and second servomotors 42a. 42b and the rotation phase difference A<p therebetween for 
each unit time At, i.e.. in response to the rising of the first timing pulse signal CL1 from "0" level to "1" 
level as shown in Figs. 41(a) and 42(a). In Figs. 41(a) and 42(a). for generalization, the numbers of rotations 
s IMi. N 2 (N, -N 2 =N) to be calculated by the controller 110 at an arbitrary time t are represented by the 
number of rotations N, +1l and the rotation phase difference A<fr is represented by A*,*,. The number of 
rotations N, and the rotation phase difference A*, are the results of the calculation by the controller 110 at 
the time t-At, not shown in Figs. 41 and 42. 

10 (b) Operation in Microprocessor 

In response to the rising of the first timing pulse signal CL1 from "0" level to "1" level the 
microprocessor 120 reads the number of rotations N, and rotation phase difference A*, from the controller 
1 10 to start the calculations of the number of pulses to be applied to the first and second servomotors 42a 
and 42b. that is, the first and second calculations (Figs. 41(c) and 42(c)). The algorithm for determining the 
numbers of pulses (AP,), (the first calculation result) and (AP 2 ), (the second calculation result) to be given 
per unit time At from the number of rotations N, and rotation phase difference A*, is derived in the followino 
manner. a 

Assuming that both of the numbers of pulses required per one rotation of the first and second 
servomotors 42a and 42b are n (the number of pulses per rotation) and the rotation phase difference 
between the servomotors 42a and 42b is zero, the number of command pulses (AP A ) ( to be applied to the 
servomotors 42a and 42b per unit time At is: 



»5 
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A* = 2s 



[ 4(A* 1+ A* 2 )f Q 



(42) 



30 



35 



40 



45 



The number of rotation phase difference command pulses (AP B ), required for generation of the rotation 
phase difference A* between the rotation phases of the servomotors 42 and 42b is: 

(AP B )i = A4>,'n/2» (43) 

Assuming that the initial value (AP 8 )o of the number of rotation phase difference command pulses 
(AP B ), is zero, the rotations of the servomotors 42a and 42b with the rotation phase difference (A** at the 
time t corresponds to the acceleration or deceleration of the servomotors 42a and 42b. which have rotated 
with the rotation phase difference (A*),., in the time interval between the previous time t-At and the time t 
such that they rotate with the rotation phase difference (A** at the time t. The number of pulses (d„)i 
required for the acceleration or deceleration at the time t is: 

(d p )i = (APbMAPb)m (44) 

When it is supposed that the servomotors 42a and 42b uniformly share torque for the acceleration or 
deceleration (although the torque may be applied to one of the servomotors), the numbers of pulses (AP,V 
and (AP 2 )i to be applied to the first and second servomotors 42a and 42b at the time t within f -.e unit time 
At are: 



50 



(AP,), = (AP A ) j + (d p ) i /2 (45) 
(AP 2 >, = (AP A )r(d p )/2 (46) 



The microprocessor 120 can convert the calculated values of the number of rotation N, and rotation 
phase drfference A*, into the numbers of pulses (AP,* and (AP 2 ), to be applied to the servomotors 42a and 
55 42b on the basis of the formulas (42) to (46) for each unit time At. 
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(c) Operation in First Pulse Train Formation Circuit 

The operation of the first pulse train formation circuit 140 will be described in detail below. After the end 
of the first calculation, the microprocessor 120 loads the first calculation result (APifc to the upper command 
buffer 141. The upper command buffer 141 reads the first calculation result (APi) it which is held in the 
upper command buffer 141 until the time t + At. 

The lower command buffer 142 reads the first calculation result (AP1V1 which has been held by the 
upper command buffer 141 in synchronism with the first timing pulse signal CL1 at the time t to store the 
new first calculation result (APi ) M in place of the first calculation result (APi which has been held by the 
lower command buffer 142 and to load the first calculation result (APi)*., to one of the input portions of the 
adder 143. 

In synchronism with the falling of the second timing pulse signal CL2 from w 1 w level to w 0" level (at the 
time ti), the accumulation result is loaded from the accumulator 144 to the other input portion of the adder 
143. Since the second timing pulse signal CL2 has 2 N -number of pulses per unit time At, the first 
calculation result (APi) M is accumulated 2 N times in the lower command buffer 142, adder 143 and 
accumulator 144 during the time At. That is, the following calculation is performed. 



Since the number of digits of the adder 143 is N bits as described above, the formula (47) means that 
the carry is performed (APi)m times in the adder 143. Accordingly, (APi ^-number of pulses are outputted 
from the adder 143 during the time At. 

On completion of the aforesaid calculations, the same series of calculations start at the time t+At again, 
and (APi fc-number of pulses are outputted during the time At Subsequently, (APi ) i+1 -number of pulses, 
(APi)j + 2 -number of pulses, ... are similarly outputted per unit time At. The first pulse train signals fi which 
are different in the number of pulses are formed for each unit time At. 

(d) Operation in Second Pulse Train Formation Circuit 

The operation of the second pulse train formation circuit 150 is substantially similar to that of the first 
pulse train formation circuit 140. Thus the second pulse train signals f 2 which are different in the number of 
pulses are formed for each unit time At as shown in Fig. 42(h). 

(e) Operation of Servomotors 

The first and second pulse train signals fi and f 2 are applied to the first and second servomotors 42a 
and 42b through the first and second servo-amplifiers 160 and 170, respectively. As a result, the first and 
second servomotors 42a and 42b accelerate or decelerate synchronously for each unit time At and rotate 
during each unit time At, with the predetermined number of rotations held constantly and the predetermined 
rotation phase difference held relatively. Since the control signal generator 100 of the present invention has 
the aforesaid simple electrical structure, little errors are generated in the microprocessor 120 and first and 
second pulse train formation circuits 140, 150, as f*r as the timing pulse generation circuit 130 correctly 
produces the first and second timing pulse signals CL1 and CL2. The two different pulse train signals fi and 
f 2 emitted from the control signal generator 100 permit the continuous drive of the servomotors 42a and 42b 
to be controlled with high exactness. 

(f) Modifications 

Although the number of rotations N { and rotation phase difference A<fr are calculated by the controller 
110 in synchronism with the first timing pulse signal CL1 in the preferred embodiment, the present invention 
is not limited to this. The calculation may start at any time within the unit time At, and the controller 110 
may be synchronized so that the calculation is completed within the unit time At. It is unnecessary to use 



c [(AP 1 ) i ]J 



= (AP 1 ) i x2 



N 



(47) 
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the first timing pulse signal CL1 as the synchronization signal of the controller 110 as in the preferred 
embodiment. Another timing signal whose phase is delayed by a predetermined time from the phase of the 
first timing pulse signal CL1 may be used as the synchronization signal. 

When the calculation results Ni, A*, of the controller 110 are constantly approximately equal (for 
5 example, when the linear interpolation is carried out between the teaching points in the laser robot RB), 
fixed calculation results are constantly loaded from the controller 110 to the microprocessor 120. so that the 
timing pulse signal for synchronization itself of the controller 110 is not required between the teaching 
points. 

When rough approximation is permitted such as the linear interpolation between all of the teaching 
io points, there is no need to divide the command buffers in the first and second pulse train formation circuits 
140 and 150 into two types, upper and lower, as shown in Rg. 40, and one type of command buffers are 
sufficient. Hence it is not necessary to apply the first timing pulse signal CL1 to the first and second pulse 
train formation circuits 140 and 150. In this case, the first timing pulse signal CL1 for controlling the 
microprocessor 120 and the second timing pulse signal CL2 for controlling the first and second pulse train 
75 formation circuits 140 and 150 are significant as synchronization signals. 

In the preferred embodiment, the beam weaver 10 includes the two servomotors 42a and 42b. The 
present invention is applicable to the beam weaver 10 which includes several (three or more) servomotors. 
In such a case, the number of pulse train formation circuits must be equal to the number of servomotors. 
While the present invention has been described in detail with reference to the preferred embodiments 
20 shown in the drawings, the present invention can be carried out in various forms without affecting the 
concept or major characteristics thereof. The aforesaid preferred embodiments are in all aspects illustrative 
and not restrictive. 

The scope of the present invention is represented by the claims and is not restricted by the description 
in the specification. All modifications and variations in the uniform scope of the claims are within the range 
25 of the present invention. 

Claims 

1. A laser robot (RB) which propagates a laser beam (LB) along an arm (4) and performs a predetermined 
30 processing while directing said laser beam (LB) from a torch (7) mounted on a leading edge of said 

arm (4) to workpieces (21, 22) and travelling said torch (7) along a processing line (l) on said 
workpieces (21 , 22), comprising: 

laser beam generation means (8) for generating said laser beam (LB) to introduce said laser beam 
(LB) into said arm (4), 

35 a plurality of inclined mirrors (41a. 41b) having reflecting surfaces inclined from planes perpendicu- 

lar to directions of predetermined rotation axes respectively and arranged in series along an optical 
path of said laser beam (LB) for serially reflecting said laser beam (LB) by said respective reflecting 
surfaces to introduce said laser beam (LB) to said torch (7), 

a plurality of inclined mirror rotation mechanisms (40a, 40b) for rotating said plurality of inclined 

40 mirrors (41a, 41b) on said rotation axes, respectively, and 

control means (100) for controlling rotations of said plurality of inclined mirror rotation mechanisms 
(40a, 40b). 

2. The laser robot of claim 1 , wherein 

45 said control means (100) includes 

means for producing a control signal which operates so that said plurality of inclined mirrors ^la 
41b) are equal in the number of rotations (Nt , N 2 ) and in rotation direction, to apply said control signal 
to said plurality of inclined mirror rotation mechanisms (40a, 40b). 

so 3. The laser robot of claim 1 , wherein 

said control means (100) includes 

means for producing a control signal which operates so that said plurality of inclined mirrors (41a 
41b) are equal in the number of rotations (f\h, hfe) and adjacent ones of said plurality of inclined mirrors 
(41a, 41b) are opposite in rotation direction, to apply said control signal to said plurality of inclined 
55 mirror rotation mechanisms (40a, 40b). 
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4. A method of controlling a laser robot (RB) which propagates a laser beam (LB) along an arm (4) and 
performs a predetermined processing while directing said laser beam (LB) from a torch (7) mounted on 
a leading edge of said arm (4) to workpieces (21, 22) and travelling said torch (7) along a processing 
line (X) on said workpieces (21, 22), said method comprising: 

5 a first step of arranging a plurality of inclined mirrors (41a, 41b) and a plurality of inclined mirror 

rotation mechanisms (40a, 40b) in series along an optical path of said laser beam (LB), said plurality of 
inclined mirrors (41a, 41b) having reflecting surfaces inclined from planes perpendicular to directions of 
predetermined rotation axes respectively and serially reflecting said laser beam (LB) by their reflecting 
surfaces to introduce said laser beam (LB) to said torch (7). said plurality of inclined mirror rotation 

w mechanisms (40a, 40b) rotating said plurality of inclined mirrors (41a. 41b) on said rotation axes, 

respectively, 

a second step of specifying speeds (V h V^) at which said torch (7) travels along said processing 
line (X) while performing said predetermined processing and a distance (pi ) said torch (7) travels along 
said processing line (X) within a cycle of deflection of said laser beam (LB), 
15 a tnir d step of specifying a spin diameter (Wi ) of said laser beam (LB) emitted from said torch (7). 

a fourth step of determining the numbers of rotations (Ni. N 2 ) of said plurality of inclined mirrors as 
a function of said speeds and said distance, 

a fifth step of determining a rotation phase difference (A<£) between two of said inclined mirrors 
(41a, 41b) which are adjacent to each other as a function of said spin diameter (Wi ), and 
20 a sixth step of producing drive outputs (Di , Cfe) as a function of said numbers of rotations (Ni , ISfe) 

and rotation phase difference (A<£) which are determined in said fourth and fifth steps and applying said 
drive outputs (Di , Cfe) to said plurality of inclined mirror rotation mechanisms (40a, 40b) to rotate said 
plurality of inclined mirrors (41a. 41b) in the same direction with the same number of rotations (Ni N 2 ) 
held. 

25 

5. The method of claim 4, wherein 

said second step includes the step of 

determining the speeds (Vj. Vy) of said torch (7) for each processing point (P if P u ) on which said 
predetermined processing is to be performed in said processing line (I) as a function of Cartesian 
30 position coordinates (Xj, Xy) of a tip of said torch (7) at said processing points (Pi, Py). 

6. A method of controlling a laser robot (RB) which propagates a laser beam (LB) along an arm (4) and 
performs a predetermined processing while directing said laser beam (LB) from a torch (7) mounted on 
a leading edge of said arm (4) to workpieces (21, 22) and travelling said torch (7) along a processing 

35 line (X) on said workpieces (21, 22), said method comprising: 

a first step of arranging a plurality of inclined mirrors (41a, 41b) and a plurality of inclined mirror 
rotation mechanisms (40a, 40b) in series along an optical path of said laser beam (LB), said plurality of 
inclined mirrors (41a. 41b) having reflecting surfaces inclined from planes perpendicular to directions of 
predetermined rotation axes respectively and serially reflecting said laser beam (LB) by their reflecting 

40 surfaces to introduce said laser beam (LB) to said torch (7), said plurality of inclined mirror rotation 

mechanisms (40a, 40b) rotating said plurality of inclined mirrors (41a, 41b) on said rotation axes, 
respectively, 

a second step of specifying speeds (V if Vg) at which said torch (7) travels along said processing 
line (X) while performing said predetermined processing and a distance (P2) said torch (7) travels along 
45 said processing line (X) within a cycle of deflection of said laser beam (LB), 

a third step of specifying Cartesian position coordinates (Xj, Xq) of a tip of said torch (7) at 
processing points (Pj, Pg) on which said predetermined processing is to be performed in said 
processing line (X) and drive amounts (0. a, 0, Y, Z) of said arm (4) for travelling said torch (7) onto 
said processing points (Pj.Pjj), 
50 a fourth step of determining the numbers of rotations (Ni , N2) of said plurality of inclined mirrors as 

a function of said speeds (V s , V u ) and said distance (P2), 

a fifth step of determining a rotation phase difference (A<*>) between two of said inclined mirrors 
(41a, 41b) which are adjacent to each other for each of said processing points (P*. Py) as a function of 
said position coordinates (Xj, Xjj) and said drive amounts (6, a, 0, Y, Z), and 
55 a slxtn ^p of producing drive outputs (Di , D2) as a function of said numbers of rotations (Ni , N 2 ) 

and rotation phase difference (A<t>) which are determined in said fourth and fifth steps and applying said 
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drive outputs (D,, Cfc) to said plurality of inclined mirror rotation mechanisms (40a. 40b) to rotate 
adjacent ones of said plurality of inclined mirrors (41a, 41 b) in opposite directions with the same 
number of rotations (N, , N 2 ) held. 

7. The method of claim 6, wherein 

said second step includes the step of 

determining the speeds (V,, V (j ) of said torch (7) for each of said processing points (P,. P n ) as a 
function of said Cartesian position coordinates (X,, Xy) of the tip of said torch (7) at said processing 
points (Pj, Pjj). 

a A light beam deflector for periodically deflecting a light beam (LB), comprising: 

first and second inclined mirrors (40a, 40b) having reflecting surfaces inclined from planes (PL, 
PL 2 ) perpendicular to directions of predetermined rotation axes (RA, , RA2) respectively and arranged in 
series along an optical path of said light beam (LB) for serially reflecting said light beam (LB) by said 
respective reflecting surfaces to introduce said light beam (LB) to a predetermined space, 

first and second inclined mirror rotation mechanisms (40a, 40b) for rotating said firWt and second 
inclined mirrors (41a, 41b) on said rotation axes^espectively, and 

control means (100) for controlling rotations of said first and second inclined mirror rotation 
mechanisms (40a, 40b), 

wherein said light beam (LB) is reflected in series by said first and second inclined mirrors (41a 
41b) wh.le said first and second inclined mirrors (41a. 41b) rotate in response to a control signal 
applied to said inclined mirror rotation mechanisms (40a, 40b) by said control means (100) to thereby 
periodically deflect said light beam (LB) in said predetermined space. 

The light beam deflector of claim 8, wherein 
said control means (100) includes 
means for producing the control signal which operates so that said first and second inclined mirrors 
(41a, 41b) are equal in the number of rotations (N, , N 2 ) and in rotation direction. 

30 10. The light beam deflector of claim 8, wherein 
said control means (100) includes 

means for producing the control signal which operates so that said first and second inclined mirrors 
(41a, 41b) are equal in the number of rotations (N, , N 2 ) and are opposite in rotation direction. 

For use in a light beam deflector (10) which includes first and second inclined mirrors (41a, 41b) having 
reflecting surfaces inclined from planes (PL t , PU) perpendicular to directions of predetermined rotation 
axes (RA,, RA 2 ) respectively and arranged in series along an optical path of a light beam (LB) for 
serially reflecting said light beam (LB) by said respective reflecting surfaces to introduce said light 
beam (LB) to a predetermined space, first and second inclined mirror rotation mechanisms (40a 40b) 
for rotating said first and second inclined mirrors (41a, 41b) on said rotation axes, respectively and 
control means (100) for controlling rotations of said first and second inclined mirror rotation mecha- 
nisms (40a, 40b), wherein said light beam (LB) is reflected in series by said first and second inclined 
mirrors (41a. 41b) while said first and second inclined mirrors (41a, 41b) rotate in response to a control 
signal applied to said inclined mirror rotation mechanisms (40a, 40b) by said control means (100) to 
thereby periodically deflect said light beam (LB) in said predetermined space, as said control means 

a control signal generator (100) for generating control signals (fi , f 2 ) to be applied to said first and 
second rotation mechanisms (40a, 40b), comprising; 

a controller (110) for calculating the numbers of rotations (Ni, N 2 ) of said first and second rotation 
mechanisms (40a, 40b) and a rotation phase difference (A<*>) between said first and second rotation 
mechanisms (40a, 40b) as a function of a predetermined algorithm. 

a processor (120) connected to an output portion of said controller (110) for calculating the 
numbers of pulses to be applied to said first and second rotation mechanisms (40a, 40b) respectively 
per predetermined time from a calculation result of said controller (110) in response to a first timing 
pulse signal (CL1) to output calculation results with respect to the numbers of pulses as first and 
second calculation results (AP, , AP 2 ) respectively, 

a first pulse train formation circuit (140) connected to one output portion of said processor (120) for 
converting said first calculation result (AP,) into a pulse train to form a first pulse train signal (f,) in 
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response to a second timing pulse signal (CL2), to apply said first pulse train signal (fi ) to said first 
rotation mechanism (40a), 

a second pulse train formation circuit (150) connected to the other output portion of said processor 
(120) for converting said second calculation result (AP 2 ) into a pulse train to form a second pulse train 
signal (f 2 ) in response to the second timing pulse signal (CL2), to apply said second pulse train signal 
(f 2 ) to said second rotation mechanism (40b), and 

a timing pulse generation circuit (130) for generating said First and second timing pulse signals 
(CL1.CL2). 

12. The control signal generator of claim 11, 

wherein said first pulse train formation circuit (140) includes 

a first buffer connected to one of the output portions of said processor (120) for holding said first 
calculation result (APi ), 

an accumulator (144) for outputting a holding addition result in response to said second timing 
pulse signal (CL2), and 

an adder (143) for adding said first calculation result (APi) held by said first buffer to an output 
result of said accumulator (144) to output the^addition result as a new addition result to said 
accumulator (144) and to output a single pulse each time the addition result becomes a predetermined 
value, and 

wherein said second pulse train formation circuit (150) includes 

a second buffer connected to the other output portion of said processor (120) for holding said 
second calculation result (AP 2 ), 

an accumulator (154) for outputting a holding addition result in response to said second timing 
pulse signal (CL2), and 

an adder (153) for adding said second calculation result (AP 2 ) held by said second buffer to an 
output result of said accumulator (154) to output the addition result as a new addition result to said 
accumulator (1 54) and to output a single pulse each time the addition result becomes a predetermined 
value. 

13- The control signal generator of claim 12, 
wherein said first buffer includes 

a first upper buffer (141) for holding said first calculation result (APi) during a time interval between 
end of a predetermined calculation by said processor (120) and start of a new predetermined 
calculation by said processor (120), and 

a first lower buffer (142) for receiving and holding said first calculation result (APi) held by said 
first upper buffer (141) in response to said first timing pulse signal (CL1), and 
wherein said second buffer includes 

a second upper buffer (151) for holding said second calculation result (AP 2 ) during a time interval 
between end of a predetermined calculation by said processor (120) and start of a new predetermined 
calculation by said processor (120), and 

a second lower buffer (152) for receiving and holding said second calculation result (AP 2 ) held by 
said second upper buffer (151) in response to said first timing pulse signal (CL1). 

14. The control signal generator of claim 13. wherein said first and second rotation mechanism (40a, 40b) 
45 include first and second servomotors (42a, 42b), respectively. 

15. The control signal generator of claim 14, wherein said timing pulse generation circuit (130) includes a 
counter circuit (131) for counting said second timing pulse signal (CL2) to produce said first timing 
pulse signal (CL1) as a function of the counted result. 
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